/******************************************************************
简介：实现Mega2560扩展版控制而自由度舵机

接线:
              云台
          上方舵机引脚:4

          下方舵机引脚:6

日期：2024.11.29
QQ交流群：811348489
寄语：代码中能遇见你，真好，有你，真好.
署名：有你同创智能机器人科技(北京)有限公司.
******************************************************************/

#include "uni_servo.h"

//注意，此方法目前最大支持20个舵机，后期会增加到最大支持50个舵机
UNI_SERVO_S servo(4, 6); //声明4,6引脚舵机

void setup(){
  delay(1000);
  Serial.begin(115200);
  servo.init(); //舵机引脚初始化设置
}

void loop(){
  servo.move(30, 60);  //引脚4舵机转动到30度，引脚6舵机转动到60度
  delay(500);
  servo.move(90, 120); //引脚4舵机转动到90度，引脚6舵机转动到120度
  delay(500);
  servo.move(13, 120); //引脚4舵机转动到13度，引脚6舵机转动到120度
  delay(500);
}